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10 CYCLES 



FIG. 6 



f START OF CR DRIVING "\ 
START PROCESSING J 









[ INITIALIZATION PROCESSING ] 

spdOld300 = 0 
intCmp = INTEGRAL COMPENSATION 
VARIABLE DEFAULT VALUE ( = 0 ) 
spdCmp300 = INITIAL SPEED 


— S601 








READ CURRENT POSITION FROM REGISTER, 
AND SAVE CURRENT POSITION IN posStart300 


--S602 








ACTIVATE 1-MSEC CYCLE TIMER 


^S603 


1 







( END ) 
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FIG. 7 



C 



START OF 1 -MSEC CYCLE SERVO 
CONTROL TIMER PROCESSING 



[ GENERATION OF IDEAL SPEED PROFILE ] 
OBTAIN IDEAL SPEED spdMnp300 BY IDEAL SPEED 
PROFILE GENERATION ROUTINE 



[ SPEED INFORMATION ACQUISITION PROCESSING j 



[ DIFFERENTIAL OPERATION D ] 
spdDif 

= (spdFed300 - spdOld300 ) * difPrm + spdFed300 



spdErr300 = spdMnp300 - spdDif 
spdOld300 = spdFed300 



( LOW-PASS FILTER OPERATION ] 
spdCmp300 

( spdCmp300 - spdErr300 ) *filPrm + spdErr300 



[INTEGRAL OPERATION I] 
intCmp = spdCmp300 * intPrm + intCmp 



[ PROPORTIONAL OPERATION P ] 
mtr_pwm = ( spdCmp300 + intCmp ) * spdPrm 



[CURRENT OUTPUT] 
OUTPUT CURRENT VALUE OF OPERATION RESULT mtr_pwm 



S701 



S702 



S703 



S704 



S705 



S706 



S707 



S708 



( END ) 
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FIG. 8 



C 



SPEED INFORMATION 
ACQUISITION PROCESSING 




CALCULATE SPEED INFORMATION 
FROM IDEAL SPEED AND 
SUBSTITUTE SPEED 
INFORMATION INTO spdFed300 

spdFed300 = 
spdMnp300*( estimateStartPrm 
/ estimateStartPrmScal ) 



OBTAIN CURRENT SPEED 
INFORMATION FROM ENCODER 

AND SUBSTITUTE SPEED 
INFORMATION INTO spdFed300 



C END ) 
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TARGET 
SPEED 




ACCELERATION 
REGION 
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FIG. 9A 



DETECTED SPEED 
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(PRINTING) REGION 

ENCODER SPEED REFERENCE REGION 
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REGION 



DECELERATION 
REGION 



TIME 
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SPEED 



ESTIMATED 
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ACCELERATION 
REGION 



FIG. 9B 

DETECTED SPEED 



FIRST EMBODIMENT 




IDEAL 
REGION 



CONSTANT-SPEED 
(PRINTING) REGION 

ENCODER SPEED REFERENCE REGION 



DECELERATION 
REGION 



TIME 
( MSEC ) 



SPEED 
ESTIMATION 
REGION 



